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(54) CONTROLLER AND CONTROL METHOD FOR PRESSING BY SERVO MOTOR 



(57) An applied force Td is estimated by an 
observer. A gain A is multiplied by a value obtained by 
subtracting the estimated applied force Td from com- 
manded force Fc. From this multiplied value, product of 
a speed feedback amount and a gain Kv is subtracted to 
obtain a torque command. With this torque command 



Tc, servo motor (2) is driven. Since feedback control of 
applied force is performed, response is fast, and applied 
force can be accurately controlled. Feedback control of 
an applied force whose vibration is prevented can be 
performed by adjusting the gains A and Kv. 
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Description 



Technical Field 



[0001] The present invention relates to a method for 
controlling an applied lorce, which is applied by a mov- 
able object (for example, a pair of welding tips of a weld- 
ing gun for a spot welding) whose driving is controlled 
by a servo motor, to another object, and an apparatus 
therewith. 

Background Art 

[0002] Generally, an applied force that is applied by a 
movable object whose driving is controlled by a servo 
motor to another object is controlled so that torque more 
than preset torque may not be generated from the servo 
motor, by applying a torque limit to an output of a speed 
control loop, that is, a torque command value. 
[0003] For example, in the case of a welding gun for 
spot welding that is driven by a servo motor, work is 
pinched with welding tips of an electrode section of the 
welding gun, is pressed in predetermined pressure gen- 
erated by the output torque of the servo motor, and is 
welded by applying electricity between the welding tips. 
[0004] In this welding gun.a move command is given 
to the servo motor driving the welding gun, the com- 
mand which makes the servo motor advance further in 
pressing direction over pressing points. Then, even if 
the electrode tips contact to the work and are stopped, 
moving length by the move command remains. There- 
fore, the servo motor attempts to make the electrode 
tips advance, and hence, the torque command value 
outputted from the speed loop increases to attempt to 
make the electrode tips advance further increases. 
Then, by applying a torque limitation to this torque com- 
mand value, the work is pressed with this constant out- 
put torque limited. 

[0005] The above method has a problem that the 
vibration of the applied force arises because an end of 
the welding gun becomes a spring and another problem 
that cycle time is delayed because it takes time for the 
pressure to become preset applied force since it takes 
time for the torque command value to the servo motor to 
reach the torque limitation value. Furthermore, if the 
welding tips of the electrode section of the welding gun 
that are driven by the servo motor move, acceleration 
torque for this movement is lost from the output torque 
limited, and hence the applied force lacks in conse- 
quence. 

Disclosure of the Invention 

[0006] An object of the present invention is to provide 
a method for controlling force application with a servo 
motor for not only preventing the applied force from 
vibrating but also preventing the applied force from 
delaying, and for preventing the applied force from lack- 



ing, and an apparatus therewith. 
[0007] In order to achieve the above object, a method 
for controlling force application with a servo motor, in 
which an applied force of a movable object driven by a 
5 servo motor to another object is controlled, according to 
the present invention comprises: a step of forming a 
force control loop with an applied force commanded to 
the servo motor and the applied force estimated by an 
observer; and a step of performing feedback control of 
w the applied force. 

[0008] In addition, preferably, the method further com- 
prises a step of detecting the speed of the movable 
object to perform the feedback control of speed, too. 
[0009] In addition, an apparatus for controlling force 
is application with a servo motor, according to the present 
invention, controls an applied force of a movable object, 
driven by the servo motor, to another object, and com- 
prises: an observer estimating the applied force; and 
force control loop execution means for performing the 
20 force feedback control with an applied force com- 
manded to the servo motor and the applied force esti- 
mated by the observer. 

[0010] In addition, preferably, the apparatus further 
comprises: speed detection means detecting the speed 
25 of the movable object; and speed feedback control 
means performing the speed feedback control. 
[001 1 ] Since the present invention performs feedback 
control of the applied force by the movable object (weld- 
ing tips) driven by the servo motor, the present invention 
30 can generate the applied force, which is targeted, with 
good response. Furthermore, the present invention can 
accelerate the cyde time of work. Moreover, the present 
invention can adjust the applied force lest vibration 
should arise in the applied force, by adjusting the gain of 
35 the force feedback control and the gain of the speed 
loop provided in the force loop. Hence, the present 
invention can constantly generate the applied force, 
which is targeted, without the vibration arising during 
force application. 
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Brief Description of the Drawings 



[0012] 



FIG. 1 is a block diagram showing a force control 
loop, which is constructed for a servo motor, for 
executing force application control by the servo 
motor according to the present invention; 
FIG. 2 is a flow chart showing the processing for 
performing the force application control shown in 
FIG. 1 , with every position and speed loop process- 
ing cycle; 

FIG. 3 is a block diagram showing a disturbance 
estimation observer used in the force application 
control shown in FIG. 1 ; and 
FIG. 4 is a block diagram showing the hardware of 
a control system executing the force application 
control shown in FIG. 1 . 
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Best Mode for Carrying Out the Invention 

[001 3] A control method of an applied force by a mov- 
able object, whose driving is controlled by a servo 
motor, according to the present invention will be s 
described below with exemplifying a case that the mov- 
able object is composed of welding tips of a welding gun 
for spot welding that is driven and controlled by the 
servo motor. 

[0014] FIG. 1 is a block diagram showing a force con- 10 
trol loop which is constructed for a servo motor driving 
the welding tips for spot welding. 
[001 5] This block diagram includes: term 1 of a trans- 
fer function of a gain A for a force feedback control; term 
2 of a transfer function of the servo motor; and term 3 of 15 
a transfer function of a speed loop gain Kv for speed 
feedback. In addition, symbol Kt in the term 2 repre- 
sents a torque constant of the servo motor driving the 
welding tips of the welding gun, J does inertia, and S 
does a Laplace operator. 20 
[0016] The driving and control of the servo motor (2) 
is performed by: subtracting an applied force Td, which 
is estimated by an observer that estimates disturbance 
applied to the servo motor, from a force application 
command Fc that is a target value of the applied force 25 
tnat the welding tips apply to an object to be welded; 
multiplying the subtracted value (Fc - Td) by the gain A; 
and obtaining a value (A*(Fc-Td)-v*Kv) as a torque 
command value Tc, by subtracting from the value 
(A'(Fc-Td)) a value (v*Kv) which is obtained by mufti- 30 
plying a,speed feedback value v by the speed loop gain 

Kv 

[0017] Let a spring constant be K and let a damping 
constant be D, and the applied force Td estimated by 
the disturbance estimation observer can be expressed 35 
m the next equation (1): 

Td=K*e+D*v=K*9+D*0S (1) 

where symbol G is moving length after contact of 40 
the welding tips to the object to be welded, and v is var- 
iation of the moving length with respect to time, that is, 
speed. 

[0018] Then, from FIG. 1 , we obtain: 

45 

{A(Fc-Td)-Kv*v}(Kt/JS)=v (! •) 

[0019] In equation (V), from equation (1) and v=9S . 
we obtain: 

50 

{A(Fc-(K*e+D*es)]-Kv*es}(Kt/JS)=es en 

Solving equation (1") for Fc, we obtain: 

Fc=(J/(A*Kt))6S 2 +l(Kv/A)+D]eS+K*0 (2) 55 

[0020] From equations (1) and (2). a transfer function 
TD/Fc from the force application command Fc to the 



estimated applied force Td can be expressed as follows: 
Td/FC=(K+DS)/{(J/(A*Kt))S 2 +[(Kv/A)+D]S+K} (3) 

[0021] In equation (3), if S = 0, that is, the speed 
becomes "0", we obtain: 

Td/Fc=K/K=1 

Therefore, Td = Fc, and hence the target applied force 
can be obtained. 

[0022] Then, the estimated disturbance detected by 
the disturbance estimation observer, that is, the esti- 
mated applied force is graphically displayed on a display 
screen of a display unit such as a teaching pendant of a 
robot where this welding gun is mounted. Furthermore, 
the gain Kv of the speed loop is adjusted so that the 
vibration of the estimated applied force may converge. 
Alternatively, the gain A of the force control loop is 
adjusted so that the vibration of the estimated applied 
force may converge. 

[0023] Hardware of a control system executing the 
force application control shown in FIG. 1 will be 
descrtoed with reference to a block diagram in FIG. 4. 
[0024] The welding gun also is controlled by a control- 
ler 10 such as a numerical controller controlling the 
robot where the welding gun is mounted. FIG. 4 shows 
only a servo motor 14 driving the welding tips of the 
welding gun. 

[0025] Various control signals including a move com- 
mand are outputted from the controller 10 to a digital 
servo circuit 12 through shared memory 11. The digital 
servo circuit 12 comprises a processor. ROM, and 
RAM, digitally performs servo control of a position, 
speed, and the like, and further performs control of the 
force with which the welding tip presses the object to be 
welded. 

[0026] On the basis of current commands for individ- 
ual phases outputted from this digital servo circuit 12, 
the servo motor 1 4 driving the welding tips of the weld- 
ing gun and servo motors of respective axes of the robot 
are driven and controlled respectively through a servo 
amplifier 13 composed of an inverter and the like. In 
addition, the position and speed of the servo motor 14 
are detected by a detector 15 composed of a pulse 
coder, which is mounted on the motor shaft of the servo 
motor 14, and the like. The feedback signals of the posi- 
tion and speed that are outputs of this detector 15 are 
fed back to the digital servo circuit 12. In addition, the 
servo control system itself that is shown in FIG. 4 is pub- 
licly known. 

[0027] Next an example of the disturbance estimation 
observer 6 used for estimating the force (applied force) 
with which the welding tips press the welded object will 
be descrtoed with reference to a block diagram in FIG. 

3. 

[0028] In FIG. 3. the term 2 of Kt/Js in FIG. 1 is divided 
into term 4 of Kt and term 5 of 1/JS. 
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[0029] The disturbance estimation observer 6 in this 
FIG. 3 estimates disturbance torque with the torque 
command Tc and speed v of the servo motor which are 
outputted from the speed loop and the like. 
[0030] A symbol K3 in term 62 and K4 in term 63, 
which are included in the disturbance estimation 
observer 6, are respective parameters of the distur- 
bance estimation observer 6. In addition, term KtYJ' of 
term 61 is a value of a parameter to be multiplied by the 
current value Tc that is the torque command actually 
outputted to the servo motor; and is a value obtained by 
dividing a value Kt' of a nominal torque constant of the 
motor by a value J' of nominal inertia. Term 64 is an inte- 
gral term and is a term for obtaining the estimated 
speed va of the motor by integrating a value obtained by 
totaling outputs of terms 61,62, and 63. 
[0031] Assuming Kt'/J' in the block diagram of Fig. 3 
equals to Kt/J, we obtain: 

(Tc*Kt+Tdis)(1/JS)=v (4) 

{Tc*(Kt/J)+(v-va)K3 +(v-va)(K4/S)}/(1/S)=va (5) 

From equation (4), we obtain: 

Tc=(v\)S-Tdis)/Kt (6) 

Substituting equation (6) into equation (5) and arranging 
the new equation (5), we obtain: 

vS-(Tdis/J)+(v-va)*K3 +(v-va)*K4/S=vaS (7) 
Therefore, term Tdis/J can be expressed as follows: 

Tdis/J=S(v-va)+(v-va)*K3 +(v-va)*(K4/S) (8) 

From equation (8), we obtain: 

v-va=Verr =(Tdis/J){1/[S+K3+(K4/S)]} (9) 

From equation (9), the integral value X that is an output 
of term 63 is expressed as follows: 

X=Verr*(K4/S) =(Tdis/J){K4/[S 2 +K3S+K4]} (10) 

[0032] Then, in equation (10), if the parameters K3 
and K4 are selected so that poles may become stable, it 
becomes possible to make approximation of 
X = Tdis/J . Therefore, by multiplying this integral value 
X (=Tdis/J) by the parameter J'/Kf of term 65, the esti- 
mated disturbance torque Td (the estimated distur- 
bance torque whose dimensions are met with those of 
the torque command Tc) is obtained. 
[0033] In the state of the welding tips of the welding 
gun pressing the welded object, it is possble to assume 
that the applied force is equal to the estimated distur- 
bance torque Td obtained from the disturbance estima- 
tion observer. In addition, the disturbance estimation 



observer shown in FIG. 3 is publicly known (for exam- 
ple, refer to Japanese Patent Application Laid-Open No. 
7-110717), the applied force can be estimated with 
another form of disturbance estimation observer instead 

5 of this disturbance estimation observer. 

[0034] Next, the processing that the processor of the 
digital servo circuit 12 performs with every position and 
speed loop processing cycle will be described with ref- 
erence to the flow chart in FIG. 1 . 

io [0035] The controller 1 0, according to a teaching pro- 
gram, outputs a move command with every distribution 
cycle to each axis of the robot, further outputs a move 
command for moving the welding gun mounted on a 
wrist of the robot to a weld position. Furthermore, the 

is controller 10 outputs a move command for moving the 
welding tips move to the position where the welding tips 
press the welded object, thereafter, outputs a command 
for switching a control mode to force application control, 
and sets a flag F of the shared memory 1 1 to "1 

20 [0036] Then, the controller 1 0 that received a signal of 
weld completion from the welding gun outputs a com- 
mand for switching a control mode from the force appli- 
cation control to normal position and speed control. 
Furthermore, the controller 10 sets the flag F to "O" and 

25 outputs the next move command. The controller 1 0 exe- 
cutes the above operation on the basis of the teaching 
program. 

[0037] On the other hand, the processor of the digital 
servo circuit 12 reads various commands, including the 

30 move command, from the shared memory 1 1 , and exe- 
cutes the processing, shown in FIG. 2, with every posi- 
tion and speed loop processing cycle. 
[0038] The processor of the digital servo circuit 12 
judges whether the flag F of the shared memory 1 1 that 

35 commands the force application control is set to "1" 
(step S1). If the flag F is not set to "1", the processor, 
similary to the conventional one, executes the position 
loop processing and speed loop processing on the 
basis of the move command value commanded and 

40 feedback values of the position and speed that are fed 
back from the position and speed detector 15,and 
obtains the torque command Tc (step S2). 
[0039] In addition, the processor delivers the torque 
command Tc, which is obtained hereinabove, to current 

45 loop (step S3). In the current loop processing, the proc- 
essor performs processing on the basis of this torque 
command Tc to obtain current commands for respective 
phases of the servo motor, and drives and controls the 
servo motors of respective axes through servo amplrf i- 

50 ers such as inverters. 

[0040] In addition, for at least the servo motors 14 
driving the welding tips of the welding gun, the proces- 
sor executes the processing by the observer that is 
shown in FIG. 3 (since this processing by the observer 

55 is publicly known, a flow chart of this processing is omit- 
ted), on the basis of the torque command Tc, which is 
obtained at step S2, and the speed feedback value. The 
processor then obtains the disturbance estimation 
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torque Td and stores the torque in a register (step S4), 
and terminates the processing in the position and speed 
loop processing cycle. Hereinafter, until the flag F is set 
to "rone by the controller 10 outputting the force appli- 
cation control command, the above processing is 
repeatedly executed. 

[0041 ] On the other hand, if the flag F is set to "1 " by 
the controller 10 outputting force application control 
command, the processor of the digital servo circuit 12 
detects the fact that the flag F is set to "1" (step S1). 
Consequently, the processor reads force application 
command Fc, disturbance estimation torque Td of the 
servo motor 14 driving the welding tips, which is stored 
in the register, that is, the applied force estimated, and 
also reads speed feedback value v that is fed back from 
the position and speed detector 15 (step S5). Then, the 
processor obtains torque command Tc by executing the 
force control loop processing shown in FIG. 1 and the 
speed loop processing in the force control loop. Thus, 
the torque command value Tc is obtained with perform- 
ing the following calculation (step S6): 

Tc=A*(Fc-Td)-Kv*v (11) 

[0042] The processor delivers the torque command 
value Tc, which is obtained in this manner, to the current 
loop (step S7), and drives and controls the servo motor 
1 4 for driving the welding tip through the servo amplifier 
13. Then, the process goes to the step S4, where the 
processor obtains and stores the disturbance estima- 
tion torque (the estimated applied force) Td by execut- 
ing the observer processing. Hereinafter, so long as the 
flag F is set to "1", the processor performs feedback 
control of the applied force by executing the processing 
at steps S1.S5-S7, and S4 with every position and 
speed loop processing cycle. 

[0043] When the spot welding is completed and the 
weld completion signal is inputted from the welding gun 
to the controller 10. the controller 10 outputs the signal 
for switching a control mode from force application con- 
trol to normal position and speed loop control. And the 
controller 10 sets the flag F at "0". and hereafter, distrib- 
utes the above-described move commands in a manner 
similar to the conventional one. The processor of the 
digital servo circuit 12 repeatedly executes the process- 
ing at the steps S1 through S4 with every position and 
speed loop processing cycle. 

[0044] In addition, in the force control loop, in a steady 
state, the speed feedback value v becomes "0". In a 
state where there is a small deviation (steady-state 
deviation) between the force application command Fc 
and the estimated applied force Td, the value obtained 
by multiplying a steady-state deviation by the gain A 
becomes the torque command value Tc, and hence, the 
state becomes steady. In order to eliminate this steady- 
state deviation, it may be also performed to add the esti- 
mated applied force Td, estimated by the disturbance 
estimation observer 6, to the torque command Tc and 



make the added torque command a command to the 
servo motor. Thus, in FIG. 1, it may be performed to 
subtract the output of term 3 (the product of the speed 
feedback value and gain Kv) from the output of term 1 

s (the product of the deviation between forces and the 
gain A), add the estimated applied force Td to the 
remainder, and make the sum the torque command to 
the servo motor (2). In this case, even if the deviation 
between forces becomes "CT since Fc = Td , the esti- 

io mated applied force Td is given as the torque command. 
Therefore, the estimated applied force Td is controlled 
to coincide with the force application command Fc. 
[0045] In addition, processing in this case Can be per- 
formed by adding the estimated applied force Td to 

15 equation (11) for obtaining the torque command Tc at 
step S6 in FIG. 2, as follows: 

Tc=A*(Fc-Td)-Kv*v+Td 

20 Claims 

1. A method for controlling force application with a 
servo motor, in which an applied force of a movable 
object driven by the servo motor to another object is 

25 controlled, comprising: 

a step of forming a force control loop with an 
applied force commanded to the servo motor 
and an applied force estimated by an observer; 
30 and 

a step of performing feedback control of the 
applied force. 

2. A method for controlling force application with a 
35 servo motor according to claim 1 .further comprising 

a step of detecting speed of the movable object to 
perform feedback control of speed also. 

3. A method for controlling force application with a 
40 servo motor according to claim 2, further compris- 
ing: 

a step of displaying the estimated applied- 
force; and 

45 a step of adjusting a gain of the speed feed- 

back control so that vibration of the applied 
force may converge 

4. A method for controlling force application with a 
so servo motor according to any one of claims 1 ,2, and 

3, further comprising: 

a step of displaying the estimated applied- 
force; and 

55 a step of adjusting a gain of amplification of a 

deviation between a force application com- 
mand in the force control loop and the esti- 
mated applied-force so that vibration of the 
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applied force may converge. 

5. An apparatus for controlling force application with a 
servo motor that controls an applied force of a mov- 
able object, driven by the servo motor, to another 
object, comprising: 

an observer estimating the applied force; and 
force control loop processing execution means 
for performing force feedback control with an 
applied force commanded to the servo motor 
and the applied force estimated by the 
observer. 

6. An apparatus for controlling force application with a 
servo motor according to claim 5, further compris- 
ing: 

speed detection means for detecting speed of 
the movable object; and 
speed feedback control means for performing 
speed feedback control. 

7. An apparatus for controlling force application with a 
servo motor according to any one of claims 5 and 6, 
wherein the movable object is a pair of welding tips 
ol a welding gun mounted on a wrist of a robot. 

a An apparatus for controlling force application with a 
servo motor, comprising: 



mand Tc outputted to the servo motor by using the 
following equation, instead of using the equation of 
Tc in claim 8; 

5 Tc=A*(Fc-Td)-Kv*v+Td 

and outputs the torque command Tc to the servo 
motor. 

io 1 0. An apparatus for controlling force application with a 
servo motor according to any one of claims 8 and 9, 
wherein a value of an applied force Td that the 
torque command means uses for calculation of the 
torque command Tc is a value that the applied force 

15 estimation means calculates from a torque com- 
mand Tc, which was outputted in the preceding 
cycle, and speed v, which the speed detection 
means outputted at the time of the torque command 
being outputted. 

20 



25 



30 



a controller outputting a force application con- 
trol command; 

applied-force estimation means for estimating 
an applied force produced when a movable 35 
object is driven by the servo motor and pressed 
to another object in accordance with force 
application control command from the control- 
ler; 

speed detection means for detecting an actual 40 
speed of the servo motor; and 
torque command means for calculating a 
torque command Tc outputted to the servo 
motor with using the following equation: 

45 

Tc=A*(Fc-Td)-Kv*v 



and outputting the torque command to the 
servo motor, where A and Kv are coefficients, 
Fc is a force application control command out- so 
putted from the controller, Td is an applied 
force estimated in the applied-force estimation 
means, and v is speed of the servo motor 
detected by the speed detection means. 

55 

9. An apparatus for controlling force application with a 
servo motor according to claim 8, wherein the 
torque command means calculates the torque com- 
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